arduino dc motor control with encoder